N95- 27784 


A Modified Proportional Navigation Scheme for Rendezvous and Docking 
with Ihmbling Targets: The Planar Case 

Norman Fitz-Coy + and Ming-Cheng Liu * 

AeMES Department 
University of Florida 

A two-phase proportional navigation scheme is developed for the case of two 
rigid bodies engaged in a rendezvous/docking maneuver. The target vehicle 
is nonmaneuvering, but does have constant nonzero angular and linear 
velocities. Under these conditions, it is shown that previously obtained 
solutions are not applicable. Analytical solutions are obtained leading to 
relationships between the transverse and LOS navigation constants. It is 
shown that the transverse navigation constant for the second phase of the 
maneuver must be 2. Also, initial conditions necessary for rendezvous are 
presented. 

Introduction 

The concepts of proportional navigation have been widely developed for the terminal phase of intercept 
problems [1-4]. To a lesser extent, some form of proportional navigation has found application in rendezvous 
problems [5-8], Regardless of the application (i.e., intercept or rendezvous), these studies have all used point 
mass bodies for both the target and chase vehicles. For intercept type problems, this is not an issue since one 
is only interested in two points occupying the same location in space at the same time. However, for rendezvous 
and docking type problems, this is a significant issue. For example, it is possible for two points other that the 
berthing mechanism points to come in contact with each leading to conditions which may not be favorable for 
the overall mission. 

In a recent paper [8], true proportional navigation was modified to include a commanded acceleration 
proportional to the centripetal acceleration (i.e., along the LOS). It was shown that this modification resulted 
in a simultaneous zeroing of the range-to-go and range-to-go rate, a condition necessary for rendezvous. The 
short comings of this analysis is that this is applicable only to rendezvous maneuvers between point masses. If 
this procedure is applied to rigid bodies (i.e., bodies with finite dimensions), then contact between the bodies 
may occur prior to rendezvous as is depicted in Fig. 1. In this paper, further modifications of the guidance 
scheme of Ref. 8 are presented and discussed. These modifications specifically address (i) the issue of contact 
prior to docking and (ii) targets which arc both translating and rotating. Both these issues arise due to the 
consideration of rigid bodies as opposed to point masses. 
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Kinematic Equations 


Consider the planar rendezvous scenario as depicted in Fig. 2. The target vehicle translates with constant 
velocity V T and rotates with constant angular velocity w T . The target vehicle has a berthing mechanism at point 
P which is located with respect to the vehicle’s center of mass (c.m.) by />. The chase vehicle has its berthing 
mechanism at point Q which is located with respect to the vehicle’s c.m. by 7 Q . For convenience, the docking 
and the grapple mechanisms are both assumed to be aligned with their respective position vectors. 

Let Tc, T (; , and be respectively, coordinate frames attached to the chase vehicle, the LOS vector, 
the inertial space, and the target vehicle. For motion in the^y-plane, denote the attitude and angular velocity 

of relative to by 0 and aj T = <pk , respectively. Similarly, denote the attitude and angular velocity of T c 

relative to 5F G by /? and w c = /ik. Finally, define the LOS frame T G in such a manner that the LOS vector is 

7 = - r j G and denote the attitude and angular velocity of this frame relative to by 8 and w u = Ok, 
respectively. 

The inertial acceleration of the c.m. C c of the chase vehicle is 

o 

R c = Q t x 0 T x 7 P ) + 7 + Q a x7 + Q u x (fi G . x 7) + 2 £2 G x 7 

“ &c ^ r Q ~ ^ C ^ C ^ r q) ( 1 ) 

o 

where ( ) denotes the time derivative of the components of a vector and Q T k (S T , Q c k oj t + oj g , and 

S2 C = + w G 4- <o c are the absolute angular velocities of 2 G , and SF C , respectively. Coordinatizing Eq. 

(1) in (i.e., the LOS frame) results in 

= a LOS L + a LOS J a (2) 

where 

• .2 

flttm = pd + 2gd 4- fi[r Qx sin/J + r^cos/J] - 0 [r Px cosd + r ;> sinP] 

+ (6 2 + $ 2 )[r Qx cos/3 - r & sin/3] (3) 

and 

• 2.2 

= - Q + p<3 +0 [r ft sin0 - r^cosfl] - <5[r 0l cos/3 - r^sin^] 

+ 2d4[r Ci siny3 + r & cos/3] (4) 




( 5 ) 


For convenience, the following definitions were utilized: 

d t 6 + <p 

and 

g = r + r^sin/3 + r^cos/3 (6) 

where 6 represents the absolute angular velocity of <$ G and g represents the projection of the vector from point 
P to C c onto the LOS direction; we will refer to this quantity as the “pseudo-range-to-go” to distinguish it from 
the true range-to-go r. 

Navigation Scheme 

The proposed navigation acceleration are defined as 

a LOS±c = - <j>[r Px cosd + r^sinfl] + fi[r Qx sin/3 + r ft . cos/3] 

+ (6 2 + p)[r Qx cos/3 - sin/3] (7) 

■ 2.2 

a LOSc !k ~ X LOS gc 3 + 4> [r^sinO - r^cosfl] - d[r Qx cosfi - r L)y , sin/?] 

+ 2d(i[r Qx sin(3 + r^cos/3] (8) 

where A Las i and A / av arc respectively the transverse and LOS navigation constants. The first terms of Eqs. (7) 
and (8) are the “classical” proportional terms proposed by Yaun and Hsu [8], The remaining terms of Eqs. (7) 
and (8) are required to compensate for the angular velocity ot the target and the angular velocity and angular 
acceleration of the chase vehicle 

Equating the kinematic accelerations with the proposed navigation accelerations, the equations of relative 
motion can be developed as 

gd -f 2gd = X loSL gd (9) 

g - gd = 2 los gd (10) 

which are similar to those developed in Ret. 8. It was shown that these equations have solutions 



where a s X losl - 1. By specifying g and g at some point in the trajectory (e.g., at rendezvous), Eq. (12) 
becomes a constraint relationship between X I ()Sl and X LOS . In Ref. 8, Yaun and Hsu used the conditions that the 
range-to-go and range-to-go rate are zero at rendezvous to develop a specific relationship between A /aVx and 
X LOS . In terms of the “pseudo” quantities, these conditions can be restated as: g -*> g f (since r -► 0 implies 

g = r^sin/Jy + r^cosjfy) and g -► 0 (assuming (3 = 0). These conditions are no longer valid since we arc 
concerned with rigid bodies rather than point masses. In fact, if one uses these conditions, the scenario depicted 
in Fig. 1 is generated. To avoid any contact prior to docking, we divide the maneuver into two guidance phases. 
In phase 1, the chase vehicle aligns itself with the target vehicle and acquires the angular velocity of the target 
vehicle. In phase 2, the chase vehicle maintains the angular velocity of the target and simultaneously reduces the 
range-to-go and range-to-go rate to zero. In both phases of flight, the following conditions are required for the 
chase vehicle: 

• The berthing mechanism is aligned with the LOS (i.e., ~ 0). 

• The angular velocity of the vehicle relative to the LOS is small (i.e., (3 f ^ ~ 0). 

These conditions are can be enforced with an attitude controller onboard the vehicle. 

The desired terminal conditions at the end of each maneuver phase are as follows. 

Phase 1 
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• The LOS vector is parallel to r P (i.e., 8 n = Tmn + ^ + \p where m is the number of 
revolutions of the chase vehicle with respect to the target frame and xj> is the angle between 
the vector 7 P and the i T axis). 

• The LOS relative rotation rate is zero (i.e., 0 ^ = 0). 

• The two vehicles must be separated by some distance g f ^ which must be greater than or equal 
to the sum of the largest dimension of each vehicle in order to avoid contact (i.e., 

Qfi = r \ + r Qt sinP fl + Tgy cosjifl > 0; see Fig 3) 

• The chase vehicle has some residual closing velocity as (i.e., 

Qfi = r \ + fifi( r Qx c °sfif\ - r& sinfifl) < 0 ) 

Phase 2 

• The LOS rotation rate is maintained at zero throughout this phase thereby ensuring proper 
alignment of the vehicles (i.e., 8 n - 0 and 8 ^ = 2 nut + ~ + xp). 

• The grappling mechanism of the chase vehicle approaches the docking port of the target 
vehicle (i.e., g n = r^sin^ 4- cos^). 

• The range-to-go rate approaches zero as g -* g f (i.e., g n = P n {r Qx cos/3^ - r^sin/?^) 

These requirements place constraints on the initial conditions of the chase vehicle at the beginning of the 
rendezvous maneuver. The initial conditions constraints are addressed below. 




Since the initial and terminal conditions are different for each phase, the relationship between the guidance 
constants will also be different for each phase. We now develop these relationship, first for phase 1 and then 
phase 2. 


Relationship between X LOSL and X LOS 

By substituting the appropriate initial and terminal conditions for phase 1 into Eq. (12), the following 
relationship between X LOS± and X LOS is 


'•LOS, 


. 2 

g JL 




a, 


0i“01 


'*oi' 1 


(13) 


whereaj = X LOSl ^ - 1. This constraint relationship between X LOSl ^ and k L0S ^ assures a specific closing velocity 
6/ at the end of the first stage. As is expected, the relationship developed in Ref. 8 is obtained when 
Q h = Q h ■ 0. 


Similarly, substitution of the appropriate initial and terminal conditions for phase 2 results in the following 
relationship between the guidance constants where a 2 = X LOS±i - 1. Note that the initial conditions of phase 
2 are the terminal conditions of phase 1. 
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( 14 ) 


"■los, .2 e r 

Phase 1 Solution 

We now develop an expression for the absolute attitude of LOS frame, <5, as function of g. First, we rewrite 
Eq. (11) as 


- A (£_) 

M<?o] 




where g is obtained from Eq. (12). For the first phase of flight, Eq. (12) can be written as 

q = ~ ^(c 2 - c l e 2a )' /1 = - ( Jj -j-, (c.e 2 " - c 2 ) v> (16) 

where the negative sign is chosen to ensure g < 0 and 

k =<%'-<& 0 7 ) 

c, £ Qm-e 2 fl > 0 (18) 

c 2 = Qme%' -QflOn 1 ( 19 ) 

From the definition of k, we observe that a x < 0 or a x > Vi which implies that A La9X| < 1 or k U)S1 > 3/ 2 . 
The case of a, < 0, both k and c 2 are positive. However, for the case of a x > V 2 , k is negative and c 2 is sign 
indefinite. Since the solution of Eq. (15) is dependent on the sign of c 2 , for the remainder of this paper, we 
consider the case of a I <0. 

Substituting Eq. (16) into Eq. (15) and integrating from the initial conditions to the terminal conditions of 
stage 1 yields 


_ dpi [Jc_V 

(a.-l) Ci 

a,p' 1 L 


e 2 n k 


Now, an expression for the time-of-flight can be obtained from 


/( V' 

M 


Substitution of g from Eq. (16) results in 


r, = - k v 


dg 

(c 2 - C,^ 2 "!)* 


In general, for arbitrary values of a x < 0, Eq. (22) has no known anti-derivative and therefore must be evaluated 
numerically. (Solutions are available for integer values of a ,) 

We now use Eq. (20) together with Eq. (22) to calculate the initial condition of p {)1 that will provide the 
desirable LOS attitude at the end of stage one. 

Phase 1 Initial Conditions 

First, the requirement that = 0 at the end of the first phase places a constraint on the initial relative 
attitude rate of the guidance frame. Combining Eqs. (5) and Eq. (11) with the condition ^ = Owe observe 
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where g fl replaces g. Thus, the initial LOS rate is defined by the initial and final pseudo-range-to-go and the 
transverse navigation constant of phase 1 . 


Second, the requirement that d n = 2mn + ~ + V> places a constraint on the initial value of the 

pseudo-range-to-go rate. To evaluate this constraint, we integrating Eq. (5) with <f> = w T over the entire 
time-of-flight T. to get 

&fi ~ ^01 = Qfi ~ 9 m + | (24) 

Substituting the right hand side of Eq. (20) for d n - <5 01 , the right hand side of Eq. (22) for T„ and the 
requirement 9 n = 2 mn + ^ + xp, Eq. (24) becomes 

e fl 


4 m + 1 _ , — 9 01 

~Oc*~ + ~k* 


1 


a x g 


(«,- \) c v> 


sin - 


Qn k 


- sin 


#1 M 

J J ^01 


4>dg 


(c 2 - c^\) v - 


(25) 


An analytical solution for p 01 cannot be obtained since c, = c,(^ 01 ) and c 2 = c 2 (p 01 ) (see Eqs. (18) and (19)) 
and the integral in Eq. (25) docs not have an explicit anti-derivative. However, a solution for p (ll can be obtained 
from Eq. (25) using an iterative scheme. In this paper, Newton’s method was used. For the cases analyzed, we 
assumed m = 0, implying the chase vehicle makes no complete revolution in phase 1. 

Stage 2 Solution 

The primary function of the guidance algorithm in this phase of the maneuver is to reduce both the 
range-to-go and the range-to-go rate to zero while maintaining the alignment of the berthing mechanisms. That 
is, throughout the entire second stage, we require 9=0. This is equivalent to (see Eq. (5)) 

<5 2 = \ = <P (26) 

Substituting this relationship into Eq. (11), the general solution for <5, yields 




2 

Q 02/ 




(27) 


Since g varies throughout the process, the above equality holds if and only if a 2 = 1 which implies X lJ)S± = 2. 
With a 2 ~ 1 and X LOS as defined in Eq. (14), g can be determined from Eq. (12) as 


Q 


Q l n~Q 2 

@ fl ^02 


(28) 


which is zero when g = g f . 


This completes the analysis. We now apply the results of the analysis to a typical rendezvous and docking 
scenario. 


Numerical Simulation 

The simulated results were obtained by numerically integrating the relative motion equations written in 
terms of the range-to-go r instead of the pseudo-range-to-go g. In doing so, we are able to include the dynamics 
associated with the chase vehicle (i.e., the effects of its attitude controller). The state vector used was 
[r d fi r d /?]. A fixed step size (A/ = 0.001), fourth-order Runge-Kutta integration algorithm was used to 
numerically integrate the differential equations. 

Conditions for a typical scenario are shown in Table 1. For this scenario, the initial rendezvous conditions 
determined from Eqs. (23) and (25) are 0 m = - 0.4918 and g m = - 237.54, respectively. An initial 
misalignment of /? = 0.05 and an initial alignment rate of $ = 0.04 were used for the chase vehicle. 
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Table 1. System Configuration 


r 01 

1000 

xp 

0 

Vt 

300 

^01 

3.77(1. 2n;) 

<p 

0.5 

«01 

4.712(1.5ft) 

r?x 

10 

A’LOS 1 x 

0.95 

r p> 

0 

r fl 

15 

r Q* 

0 

r f 1 

-10 

r Qy 

5 

^ LOS 1 2 

2 


Figures 4- 8 show the simulation results for the scenario depicted in Table 1. Parts (c) and (d) of Figs. 4 
and are enlargements of the terminal phase of flight depicted in parts (a) and (b). Figure 4 shows the flight 
data for the first stage. Notice that the range-to-go rate r goes to the designated value of - 10 as range-to-go 
r goes to the specified value of 15. Also the relative LOS attitude dgoes to the desirable value of 90° (1.57 rad.) 

as the relative LOS attitude rate 9 goes to approximately zero. 




Fig. 4 Phase 1 flight data 

Figure 5 shows the flight data for the second stage. Notice that the range-to-go rate r and the range-to-go 
r simultaneously approach zero. Also the relative LOS attitude 6 is maintained within the proximity of the 

desirable value of 90° (1.57 rad.). The slight variations are due to the relative LOS attitude rate 9 being close 
to zero but not exactly zero throughout the second stage. This is not a consequence of the numerics, but rather 
a consequence of the fact that an actual attitude controller was modelled for the chase vehicle. 
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Fig. 5 Phase 2 flight data 

Figure 6 shows the accelerations commanded throughout the maneuver. The curves on the left half of the 
plot are the acceleration commands for phase 1 and the curves on the right half of the plot are for phase 2. Notice 

that since 7 = - r j cp , then the a LOS accelerations shown represent accelerations in the positive r-direction. 




Fig. 6 Profiles of commanded accelerations 

Figures 7 and 8 show the terminal portions of phases 1 and 2, respectively. Figure 7 shows the chase vehicle 
approaching the target from above and acquiring properly alignment with the target at the end of the first stage. 
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Fig. 7 Alignment of chase and target vehicles at the end of phase 1 
Figure 8 shows that, during the second stage, the chase vehicle is able to maintain it s attitude with respect to 
the target while it nulls the distance between the grappling arm and the docking port. It also shows that, at the 
end of the second stage, the chase vehicle docks with the target with the proper relative attitude as specified. 



Fig. 8 Docking at the end of phase 2 
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Conclusion 


Solutions to the equations of motion of two rigid bodies engaged in a planar rendezvous and docking 
maneuver are obtained. Some solutions are analytic whereas others are pseudo-analytic. It was shown that 
rendezvous and dock of rigid bodies require a two phases maneuver. In the first phase, the LOS rotation rate 
is driven to zero while aligning the berthing mechanisms of the two vehicles, and in the second phase, the LOS 
rate is maintained at zero while the range-to-go and range-to-go rates are simultaneously driven to zero. The 
second phase of the maneuver requires a transverse navigation constant of 2. An illustrative example is 
presented. 

Future work involves the integration of appropriate sensor and actuator models and a proof-of-concept 
demonstration. 
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